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SUMMARY 

A new type of control law is derived to steer the dynamic model of a wheeled robot of unicycle 
type along a desired path. The methodology adopted for path following control deals explicitly 
with vehicle dynamics and plant parameter uncertainty. Furthermore, it overcomes stringent initial 
condition constraints that are present in a number of path following control strategies described in 
the literature. This is done by controlling explicitly the rate of progression of a "virtual target" to 
be tracked along the path, thus bypassing the problems that arise when the position of the virtual 
target is simply defined by the projection of the actual vehicle on that path. In the paper, a nonlinear 
adaptive control law is derived that yields convergence of the (closed loop system) path following 
error trajectories to zero. Controller design relies on Lyapunov theory and backstepping techniques. 
Simulation results illustrate the performance of the control system proposed. Copyright © 2003 John 
Wiley & Sons, Ltd. 
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1. INTRODUCTION 

The problem of motion control of autonomous vehicles (including air, land, and marine robots) 
has received considerable attention during the last few years. The problems addressed in the 
literature can be roughly classified in three groups: 

1. point stabilization - the goal is to stabilize the vehicle at a given point, with a given 
orientation; 
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2. trajectory tracking - the vehicle is required to track a time parameterized reference, and 

3. path following - the vehicle is required to converge to and follow a path, without explicit 
temporal specifications. 

Point stabilization presents a true challenge to control system designers when the vehicle has 
nonholonomic (or non integrable) constraints, since there is no smooth (or even continuous) 
state- feedback law that will yield stability, as pointed out by R. Brockett in [6]. To overcome 
this difficulty three main approaches have been proposed: smooth time-varying control laws 
(Canudas de Wit et al. in [8], Godhavn and Egeland in [13], and Micaelli et al. in [18]) and 
discontinuous as well as hybrid feedback laws (Aguiar et al. in [1] and [2], Astolfi in [5], 
Hespanha in [14] and Canudas de Wit and S0rdalen in [7]). 

The trajectory tracking problem for fully actuated systems is now well understood and 
satisfactory solutions can be found in advanced nonlinear control textbooks. However, in 
the case of underactuated vehicles, that is, when the vehicle has less actuators than state 
variables to be tracked, the problem is still a very interesting topic of research. Linearization 
and feedback linearization methods (Walsh et al. in [25], Freund and Mayr in [12]), as well 
as Lyapunov based control laws (Canudas de Wit et al. in [8], Fierro and Lewis in [11]) have 
been proposed. 

Path following control has received relatively less attention than the other two problems. 
See the publications of C. Samson in [20] and Micaelli et al. in [19] for pioneering work in the 
area as well as Canudas de Wit et al. in [8] and Jiang and Nijmeijer in [15] and the references 
therein. Path following systems for marine vehicles have been reported by Encarnacao et al. in 
[9] and [10]. The underlying assumption in path following control is that the vehicle's forward 
speed tracks a desired speed profile, while the controller acts on the vehicle orientation to 
drive it to the path. Typically, smoother convergence to a path is achieved, in comparison 
with the performance obtained with trajectory tracking controllers, and the control signals are 
less likely pushed to saturation. 

This paper addresses the problem of steering the dynamic model of a wheeled robot of 
unicycle type along a desired path. Its main contribution is twofold: i) it extends the results 
obtained in [19] - for kinematic models of wheeled robots - to a more general setting, in 
order to deal with vehicle dynamics and parameter uncertainty, and ii) it overcomes stringent 
initial condition constraints that are present in a number of path following control strategies 
described in the literature. This is done by controlling explicitly the rate of progression of a 
"virtual target" to be tracked along the path, thus bypassing the problems that arise when 
the position of the virtual target is simply defined by the projection of the actual vehicle on 
that path. This procedure avoids the singularities that occur when the distance to path is not 
well defined and allows for a proof of global convergence of the actual path of the vehicle to 
the desired path. This is in striking contrast with the results described in [19] for example, 
where only local convergence has been proven. To the best of the authors' knowledge, the 
idea of exploring the extra degree of freedom that comes from controlling the motion of a 
virtual target along a path appeared for the first time in the work of Aicardi et al. in [3] 
for the control of wheeled robots. The circle of ideas exploited in [3] was extended to deal 
with marine craft control in [4]. However, none of these references addresses the issues of 
vehicle dynamics and parameter uncertainty. Furthermore, the methodologies adopted in [3] 
and [4] for control system design build on an entirely different technique that requires the 
introduction of a nonsingular transformation in the original error space. Interestingly enough. 
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a recent publication, by del Rio et al. in [21] explores the same concept of a virtual target for 
path following of wheeled robots. 

hi this paper, controller design builds on the work reported in [19] on path following control 
and relies heavily on Laypunov based backstepping techniques established by Krstic, et al. in 
[16] in order to extend kinematic control laws to a dynamic setting. Parameter uncertainties 
are dealt with in an adaptive framework by augmenting Lyapunov candidate functions with 
terms that are quadratic in the parameter errors. See [1], where identical techniques were used 
in the design of an adaptive control law to steer the dynamic model of a wheeled robot to a 
point, with a desired orientation, in the presence of parameter uncertainty. 
The paper is organized as follows. Section 2 introduces the problem of path following control 
for a wheeled robot of unicyle type. Section 3 develops a nonlinear, adaptive, path following 
control law to deal with vehicle dynamics and parameter uncertainty. The performance of the 
control system proposed is illustrated in simulation in Section 4. Finally, Section 5 contains 
the conclusions and describes some problems that warrant further research. 



2. PATH FOLLOWING CONTROL. PROBLEM FORMULATION 

This section reviews the dynamic model of a wheeled robot and provides a rigorous formulation 
of the problem of steering it along a desired path. The reader is referred to [19] and [1] for 
background material. 

The following assumptions are made regarding the robot, see Figure 1. The vehicle has two 
identical parallel, nondeformable rear wheels which are controlled by two independent motors, 
and a steering front wheel. It is assumed that the plane of each wheel is perpendicular to the 
ground and that the contact between the wheels and the ground is pure rolling and nonslipping, 
i.e., the velocity of the center of mass of the robot is orthogonal to the rear wheels axis. It is 
further assumed that the masses and inertias of the wheels are negligible and that the center 
of mass of the mobile robot is located in the middle of the axis connecting the rear wheels. 
Each rear wheel is powered by a motor which generates a control torque t,; i = 1,2. 

2.1. Kinematic Equations of Motion. The Serret - Frenet Frame 

The solution to the problem of path following derived in [19] admits an intuitive explanation: 
a path following controller should look at i) the distance from the vehicle to the path and ii) 
the angle between the vehicle velocity vector and the tangent to the path, and reduce both 
to zero. This motivates the development of the kinematic model of the vehicle in terms of 
a Serret-Frenet frame {F} that moves along the path; {F} plays the role of the body axis 
of a "virtual target vehicle" that should be tracked by the "real vehicle". Using this set-up, 
the abovementioned distance and angle become the coordinates of the error space where the 
control problem is formulated and solved. In this paper, motivated by the work in [19], a Frenet 
frame {F} that moves along the path to be followed is used with a significant difference: the 
Frenet frame is not attached to the point on the path that is closest to the vehicle. Instead, the 
origin of {F} along the path is made to evolve according to a conveniently defined function of 
time, effectively yielding an extra controller design parameter. As it will be seen, this seemingly 
simple procedure allows to lift the stringent initial condition constraints that arise with the 
path following controlled described in [19]. The notation that follows is by now standard. See 
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Figure 1. Unicycle's parameters and frame definitions 

for example [20] and [19]. 

Consider Figure 1, where P is an arbitrary point on the path to be followed and Q is the 
center of mass of the moving vehicle. Associated with P, consider the corresponding Serret- 
Frenet frame {F}. The signed curvilinear abscissa of P along the path is denoted s. Clearly, 
Q can either be expressed as q = {X, Y, 0) in a selected inertial reference frame {1} or as 
(si,yi,0) in {F}. Stated equivalently, Q can be given in {X,Y) or (si,j/i) coordinates (see 
Figure 1). Let the position of point P in {1} be vector p. Let 



R 



cos 0c sin 6c 

— sin 0c cos 0c 

1 



be the rotation matrix from {1} to {F}, parameterized locally by the angle 0c. Define iUc 
Then, 



LUc = 0c = Cc{s)s 

Ccis) = gc{s)s 



(1) 



where Cc{s) and gc{s) = "^f denote the path curvature and its derivative, respectively. The 
velocity of P in {1} can be expressed in {F} to yield 
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It is also straightforward to compute the velocity of Q in {1} as 



where r is the vector from P to Q. Multiplying the above equation on the left by R gives the 
velocity of Q in {1} expressed in {F} as 



R 



+ LJc X T 



Using the relations 



dr 
'di 



X 
Y 



si 

yi 





and 



o;^ X r = 










Si 





X 


yi 


_ 9 = 


= Cc{s)s _ 

-Cc{s).- 


syi 







Cc{s)sSl 


, 










equation (2) can be rewritten as 



R 



X 
Y 





s(l - Cc(s)yi) + si 

yi + Cc(s)ssi 





Solving for si and yi yields 




cos Or sm ( 



■ sm t>r cos ( 



X 
Y 



S(l -CcJ/l) 



] 



X 
Y 



CcSSl. 



(2) 



At this point it is important to notice that in [19] si = for all t, since the location of point 
P is defined by the projection of Q on the path, assuming the projection is well defined. One 
is then forced to solve for s in the equation above. However, by doing so 1 — Ccj/i appears in 
the denominator, thus creating a singularity at j/i = — . As a result, the control law derived in 
[19] requires that the initial position of Q be restricted to a tube around the path, the radius 
of which must be less than — - — , where Cc^max denotes the maximum curvature of the path. 
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Clearly, this constraint is very conservative since the occurrence of a large Cc^max in even a 
very small section of the path only will impose a rather strict constraint on the initial vehicle's 
position, no matter where it starts with respect to that path. 

By making si not necessarily equal to zero, a virtual target that is not coincident with the 
projection of the vehicle on the path is created, thus introducing an extra degree of freedom 
for controller design. By specifying how fast the newly defined target moves, the occurrent of 
a singularity at j/i = — is removed . The velocity of the unicycle in the {1} frame satisfies the 
equation 



X 
Y 



cosf^ 
sin Or, 



(3) 



where 6^ and v denote the yaw angle of the vehicle and its body-axis speed, respectively. 
Substituting (3) in (2) and introducing the variable 6 = 6^ — Oc gives the kinematic model of 
the unicycle in the (s, y) coordinates is given by 

si = —s (1 — CcHi) + V cos 

yi = —CcSSi + V sin (4) 

= LOm — CcS 

where ujm = 0m- 

2.2. Dynamics. Problem Formulation 

The complete dynamic model of the unicycle is obtained by augmenting (4) with the equations 

I "^^ ™ .. .2 (5) 

[ ix) = LOm - CcS - gcS^ 

where cj™ = -y and m and / are the mass and the mass moment of inertia of the unicycle, 
respectively. Notice how equation v = — captures the fact that the motion of the unicycle is 
along its longitudinal axis, in reaction to the longitudinal force F. This a consequence of the 
common assumption that there is no slippage of the vehicle along its lateral axis (nonholonomic 
constraint) . 
Finally, F and N can be rewritten in terms of the control inputs ti and rg as 



where R is the radius of the rear wheels and 2L is the distance between them. 



(6) 



With the above notation, the problem under study can be formulated as follows: 
Given a desired speed profile Vd{t) > Vmin > for the vehicle speed v, and a path to be 
followed parameterized in terms of its length, derive a feedback control law for ti and ti to 
drive y\, 0, and v — Vd asymptotically to zero in the presence of plant parameter uncertainties 
in TO, /, R, and L. 
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3. NONLINEAR CONTROL DESIGN 

This section introduces a nonlinear closed loop control law to steer the dynamic model of 
a wheeled robot described by (4)- (5) along a desired path, in the presence of parametric 
uncertainties by resorting to backstepping techniques. The reader will find in [16] a lucid 
exposition of interesting theoretical and practical issues involved in backstepping. See also [1] 
for related work on wheeled robot control in the face of parameter uncertainty. Controller 
design unfolds in three basic steps where a sequence of Lyapunov functions are built to deal 
with kinematics, dynamics, and parameter uncertainty in succession. 

3.1. Nonlinear Controller Design Using the Kinematic Model 

The analysis that follows in inspired by the work in [20] and [19] on path following control 
for kinematic models of wheeled robots. Recall from the problem definition in Section 2 that 
the main objective of the path following control law is to drive j/i and 9 to zero. Starting at 
the kinematic level, these objectives can be embodied in the Lyapunov function candidate see 
[19]. 

V, = \{sl+yl) + ^{9-5{y,,v)f (7) 

where it is assumed that 
A.l. 5{Q,v) = 
A. 2. j/if sin (5(2/1, f) < 0,Vj/Vw. 
A. 3. limt^oov{t) =/= 

In the Vi Lyapunov function adopted, the first term ^{s1+yf) captures the distance between 
the vehicle and the path, which must be reduced to 0. The second term aims to shape the 
approach angle 9 = 9m — 9c of the vehicle to the path as a function of the 'lateral' distance j/i 
and speed v^ by forcing it to follow a desired orientation profile embodied in the function 5. 
See [20], where the use of & 5 function of this kind was first proposed. 

Assumption A.l. specifies that the desired relative heading vanishes as j/i goes to zero, 
thus imposing the condition that the vehicles main axis must be tangent to the path when 
the lateral distance j/i is 0. Assumption A. 2. provides an adequate reference sign definition in 
order to drive the vehicle to the path (turn left when the vehicle is on the right side of the 
path, and turn right in the other situation). Finally, Assumption A. 3. stated that the vehicle 
does not tend to a state of rest. The need for these conditions will become apparent in the 
development that follows. The derivative of Vi can be easily computed to give 

Vi = s^s^+y^y^ + ^{9-5){9-5) 
= si {v cos 9 - .3 {I- Ccyi) - sccyi) 

+yivsm9+^{9-5){9-5) 
= si (v cos 9 — s) + yiv sin 5 + - 

■ [o - S)i9 - S + jyiv'-^^^^^y 
Let the ideal (also called virtual) "kinematic control laws" for s and 9 be defined as 
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S = fCOS + fclSl 

10- 

0-S 



= 5 - lyiv ^'^lzt' (8) 

-k2{0-5). 

where fci and ^2 are positive gains. Then, 

Vi = -kisl + yivsinS- ^ ~ < 0, (9) 

7 

Note the presence of the term yivsinS in the previous equation and how assumption A. 2. 
is justified. 

3.2. Backstepping the Dynamics 

The above feedback control law applies to the kinematic model of the wheeled robot only. 
In what follows, using backstepping techniques, that control law is extended to deal with 
the vehicle dynamics. Notice how in the kinematic design the speed of the robot v{t) was 
assumed to follow a desired speed profile, say Vd{t). In the dynamic design this assumption is 
dropped, and a feedback control law must be designed so that the tracking error v{t) — Vd{t) 
approaches zero. Notice also that the robot's angular speed ujm (or equivalently the variable 
9) was assumed to be a control input. This assumption will be lifted by taking into account 
the vehicle dynamics. Following [16] define the virtual control law for (desired behaviour of 
in (8)) as 

• sin — sin 5 , ^^ , ^ 

C = S- -wiv ^ _ ^ k2{0-5) (10) 

and let e = — (^ be the difference between actual and desired values of 0. Replacing hy e-\- C, 
in the computaton of Vi gives 

Vi = — fciSi + yiwsino 

7 

+ - -^ (11) 

7 

Augment now the candidate Lyapunov function Vi with the terms e^/2 and (y — Vd)'^/2 to 
obtain 

V2 = Vi + ^ [e^ + {v- Vdf] 
with derivative 

V2 = -kisj+yivsinS- -{0- 6)'^ 

+e (1(6* -6)+e^+{v- Vd){v - Vd)- 

Simple computations show that if 

e - -'-{0-5)-k,e 

V = Vd- k4{v -Vd), 
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where k-s and /C4 are positive gains. Then 

V2 = -kisl + yivsinS (6* -5)^ 

7 

-fcge^ - k4{v - Vdf < 0. (13) 

It is now straightforward to compute the control inputs F and N (and thus ti and T2) by 
solving the dynamics equation (5) to obtain 

N = I{f,{.)-kse) 

F = m{h{-)-ki{v-va)) ^ > 

where 

hi-) = C-^{e-S)+c,s + g,s'' 
hi-) = Vd 

The above control law makes V2 negative semidefinite. This fact plays an important role in 
the proof of convergence of the robot to the path. 

3.3. Choice of the approach angle 6{yi,v) and control computation 

As explained before, the choice of the d{yi , v) function is instrumental in shaping the 
transient maneuvers during the path approach phase. In [19] the authors propose to use 
5{yi,v) = — sign(w)0a tanh(yi). This choice is natural, but raises some subtle mathematical 
difficulties because d{yi,v) is not differentiable with respect to w at w = 0. 
We propose instead the approach function 

6{yi,v) = -6atanh(ksyiv) (15) 

where < (?„ < tt/2 and ks is an arbitrary positive gain. 

Clearly, this function satisfies the assumptions A.l. and A. 2. above. The candidate controller 
proposed so far requires the computation of 6 and 6 as 



^ = S'yVi + ^i"^ + ^'yVi + ^'vV + {5'^y + 5'y^i)yiv + S'y^^.^ ' 



(16) 



where 



5'y = -0aksv{l -ta-nh^{ksyiv)), 

K = -Oaksyi{l -ta-nh^iksyiv)), 

5'y = 0a{ksv)'^2tanh{ksyiv){l -ta-nh^iksyiv)), 

§1 = 9a{ksyi)'^'^ta-nh{ksyiv){l -tanh^{ksyiv)), (17) 

5'yyi = -Oaks + Oaks ta-nh^ (ksyiv) + 6aksv2tanh{ksyiv)ksyi{l - tanh^{ksyiv)), 

S'y^2 = <^y (sin — CcSi cos 0), 

S'vy = -Oaks + Oaks ta-nh^ (ksyiv) + 6aksyi2tanh{ksyiv)ksv{l - tanh^{ksyiv)). 

Equations (16) show that it is necessary to compute the forward acceleration v and jerk i). 
Because measuring these quantities is hard at best, one must resort to the dynamic model of 
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the vehicle. Assume for the time being that the unicycle's physical parameters to, /, L, and R 
are known exactly. At this point it is convenient to redefine the control inputs Ui;i = 1,2 as 
ui = Ti — T2 and U2 = Ti + T2. This yields the dynamic equations (see (6)) 

"™ H." (18) 

where ci = -^ and C2 = mR are positive parameters. With this input transformation the 
controller can be re- written as 



U2 = C2/^2 



(19) 



where 



fli = fji - fc3 (g - 5'ym + iviv ^'^'tzr' +kAe- 6)) 

fti = fji + ksS', 

fui = s: 

ful = K 

II2 = Vd-kA{v- Vd) 

f}i = /i-i(0-5)+5cs'+Cc(«^sin0 + fciSi) 

/ji = fi + c, cose 

fi = /i_^^,Biji|^^^^^J_^^__^(^^g^(^_^)_(gi^^^_gi^^))j (20) 

+S'yyi [k2 + jTw (°°' ^^^ - ^) - ('^^ ^ - '^^ ^))] 
/* = /| - 7J/1 ""elf' + K [^2 + (Hf (°°^ <^(^ - ^) - (sin ^ - sin 5) )] 

/| = (5;,+^u)yi+^u+^;4 

/" = — CcSSi — gfcS^si + 0WCOS (? — CcSi(fciSi — flwsinfl) 
f "v = sin — CrS\ cos 

At this stage, assuming that the vehicle parameters are known exactly, the acceleration v 
and jerk v are obtained from the physical model of the vehicle as 



_ "2 _ 

C2 



3.4- Parameter Adaptation 



Vd- ki{v -Vd) ; V = ^ = Vd- ki{v -Vd)- (21) 



We now tackle the case where the unicycle's physical parameters ?7i, /, L, and R are not 
known accurately. To this effect, we start by re- writing the control law obtained in (19). Let 
Cj be the estimated values of the parameters, and Cj their actual unknown values. Define 



opt 

opt r {^^) 

U2 = C2ju2 



— Ci/m1,1 + C-iful,2 + Ciful,3 
.opt 

"2 
with 
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ful,l - 


= /^l 


C3 


C2 


ful,2 = 


= fulU2+fulC2ivd- 


C4 


^ t. 


ful,3 = 


= /^lwi-/^lC2fc4W2 


fu2 


= Wd - k4{v - Vd) 



' (23) 



where the notation u°^ was introduced to stress the fact that this (ideal) control law is 
computed with the true values of the parameters. Notice how the control law depends on 
four new parameters Ci]i = 1,..,4 that are determined by the true values of the physical 
parameters defined above. In practice, the control law defined above must be implemented 
using the estimates of q of q; i = 1, ..4 yielding the actual control law 

Ul = Cijul^l +C^ful,2 +Ciful,3, /r,-\ 

U2 = C2fu2 

Let Aq = Cj — Q, be the errors between true and estimated parameters. Notice that 
Acj = Ci — Ci = Ci] i = 1, 2, since the true parameters are constant. Using (24), 

V2 = -kisl+yivsinS- ^{6-5f 
— k-^e^ — ki{v — Vd)^ 

+ ^ (Aci/„i,i + AC3/„1,2 + AC4/„1,3) ^'^^' 

+ ^Ac2/„2 

which is no longer guaranteed to be negative semidefinite. In order to deal with this problem, 
augment V3 with the parameter error terms to obtain the final candidate Lyapunov function 

(26) 







T^3 = 


V2 


+ 


fcs Ac^ 
2 


'■+Acl 

Cl 


+ Acl^ 


keAcl 

2 C2 


and 


compute 


its derivative 




















v^ 


= 




-kisl 


+ yivsinS — 


H^ 


-5)^ 












-kse^ 


- ki{v- 


-Vd)' 


2 





+ ^iiv-Vd)fu2 + k6C2) 
+ ^(e/«l,3 + fc5C3) 

+^{efui,4 + k5Ci) 



(27) 



Let a parameter update law be defined as 



e/,.1,1 


fcs 


ke 


fc5 

e^i,4 



This choice of adaptation law cancels the non- negative terms of V3, yielding 
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V3 = -kisl + yivsinS {& - Sf 

1 

-^e^-^{v-v,f<0 
I m 



(28) 



that is, V3 becomes negative semidefinite. 

3.5. Complete System. Convergence Analysis 

From the presentation above the complete adaptive, path following control system is described 
by the state equations 



si = — s (1 — Ccj/i) + V cos ( 
yi = —CcSSi + V sin 

6j= "^-Cc's- gcs'^ 



(29) 



together with the control law 



Wl = Ciful,l + C3ful,2 + C4/«l,3 
W2 = C2/„2, 



the parameter adaptation law 



and the virtual target dynamics 



ci = 

C2 = 

C3 = 

L C4 = 



s = V cos9 + fciSi. 



e^l.l 




e/ui,3 


efui,4 



(30) 



(31) 



(32) 



In the above equations, all functions are replaced by their estimated values. The main result 
of the paper is stated next. 

Proposition 1: Consider the closed loop adaptive control system given by the dynamic 
model of the unicycle (29) driven by the control law (30), together with the adaptation scheme 
(31) and the virtual target dynamics (32). Let Vd be a desired velocity profile. Assume that 
Vd and its first and second order derivatives are bounded. Further assume that Vd does not 
tend to zero as t tends to infinity. Then yi, 0, and v — Vd tend asymptotically to zero in the 
presence of bounded plant parameter uncertainties in m,I,R, and L. Stated differently, the 
robot converges to the prescribed path asymptotically, in the presence of parametric modeling 
uncertainties, and tracks the desired speed profile Vd asymptotically. 

Proof. In what follows we describe the main steps involved in the proof of Proposition 1 . 
The proof builds on the partial results obtained so far and makes ample use of Barbalat's 
Lemma stated below. 
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Barbalat's lemma : let the function f{t) admit a second order derivative with respect to t 
and assume that the limit of f(t) when t tends to infinity is well defined. Further assume that 
fit) is uniformly continuous. Then f(t) tends to as t tends to cxd. 

For details about the Barbalat's lemma, its proof, and application, please refer to [24]. The 
key steps in the proof can be described as follows. 

• Start by considering the positive definite Lyapunov candidate V3 in (26) . Straighforward 
computations show that the choice of the control expression (30), together with the 
adaptation scheme (31) and the virtual target dynamics (32) makes V3 is negative 
semidefinite. Hence V3 is a positive and monotonically decreasing function, and therefore 
limt^oo V3 exists and is finite. 

• It is now possible to show that si, j/i, 0, e, and v are bounded because 5 and Vd are 
assumed to be bounded. From the equations above it then follows that si, yi, e, and 
i) are bounded as well. Based on this result, a straightforward differentiation of V3 will 
show that V3 is bounded and therefore V3 is uniformly continuous. 

• Finally, a simple application of Barbalats lemma shows that V3 — > as t ^ 00. As a 
consequence, the variables si, yi, 5, e and v—Vd vanish as t tends to infinity, thus proving 
that the vehicle converges to the path and tracks the desired speed profile asymptotically. 

Remark: The errors Acj, i = 1, 2, 3, 4 of the parameter estimation process do not show up 
in the final derivative of the Lyapunov function V3. Thus, convergence of the errors to zero 
cannot be guaranteed. It can be shown, however that Aq, i = 1, 2, 3, 4 converge to some limit 
values that are not necessarily zero. Nevertheless, the control law still drives the required error 
states to zero. This behaviour for the parameter estimates can be observed in a large class of 
adaptive control systems. 



4. SIMULATION RESULTS 

This section illustrates the performance of the path following control law derived through 
simulations with a dynamic model of a wheeled robot. The reference and actual robot paths 
are shown in Figure 2. The desired speed Vd{t) was set to Ims^^. The values of the design 
parameters were 7=1 and fcj =!;«=!,. ..,6. The following initial conditions were adopted 
in the simulations : 



Xq = 



si(0) 


[m] 1 




4 




4 




yi(o) 


[m] 




30 




-30 




9(0) 


[rad] 




-1.7 




1.7 




«(0) 


[m/s] 




0.1 




0.1 




^(0) 


[rad/ s\ 














m 


[m] 




10 




10 




ci(0) 


[kg-'] 












C2(0) 


[m] 












C3(0) 


[kg.m] 












cm 


[kg.m^] _ 






Simulation! 




Simulation2 
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The robot parameters used in the simulation are those of the Pioneer P3-DX robot: m = 9kg, 
I = O.lkg.m^, R = O.lm and L = Q.lbm. The corresponding values for ci, C2, C3 and C4 are 
0.06, 0.9, 0.07 and 0.08, respectively. 




A Simulation 2 



10 20 30 40 50 60 70 



Figure 2. Desired and actual robot paths 



- Simulation 1 



20 40 60 80 



Simulation 1 



100 120 

t[s] 



140 160 ISO 200 




Simulation 2 



100 
t[s] 



120 140 16 



180 200 



Figure 3. Time history of s\ (t) and yi (t) 

Figures 2 through 6 shows the results of the simulations. Notice how the lateral distance to 
the path is driven to zero and how the actual speed v{t) converges to Vd{t). Notice that s tends 
to Vd{t) as well. Finally, it is important to remark that the errors in the parameter estimates 
do not go to zero. The objective of following the desired path is achieved nonetheless. 
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Simulation 1 



20 40 60 80 100 120 140 160 180 200 

t[s] 



^Simulation 1 



20 40 



Simulation 2 

60 80 1 00 1 20 1 40 1 60 180 200 

t[s] 



Figure 4. Time history of 6{t) and 6{t) 



20 40 60 



100 120 140 160 180 200 
t[s] 




20 40 60 



Figure 5. Time history of v(t) and s(t) 
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0.5 



di -"^ - ■ — — 

o _o 5 I \ \ \ \ \ \ \ \ : 

20 40 60 80 1 00 1 20 1 40 1 60 1 80 200 
_ 1.15 
E 
F 1.1 



20 40 60 80 1 00 1 20 1 40 1 60 1 80 200 



20 40 60 80 



120 140 160 180 200 



0.98 
0.96 



20 40 60 80 1 00 1 20 1 40 1 60 1 80 200 



Figure 6. Time history of ci(t), C2{t), C3(i) and C4{t) (Simulation 1 : full line ; Simulation 2 : dashed 

line) 
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5. CONCLUSIONS AND FUTURE WORK 

The paper derived a nonlinear, adaptive control law for accurate path following of a dynamic 
wheeled robot in the presence of parameter uncertainty. The key idea behind the new control 
law developed was to control explicitly the rate of progression of a "virtual target" to be 
tracked along the path, thus bypassing the " singularity" problems that arise when the position 
of the virtual target is simply defined by the projection of the actual vehicle position on that 
path. Controller design relied on backstepping techniques. The paper offered a formal proof 
of convergence of the robot to the path. Simulation results illustrated the performance of 
the control system proposed. The research done in the scope of the present work unveiled 
some important issues that warrant further research. Among them, the following are worth 
emphasizing. 

The idea of using a virtual target for path following is present, albeit in an implicit manner, 
in the work of Aicardi et al. in [4], R. Skjetne in [22] and F. del Rio et al. in [21], where a 
virtual target control law was "intuitively chosen" even before a path following control law 
was developed. The originality of the present work lies in the fact that the virtual target 
control law falls naturally from the type of path following control law proposed, thus yielding 
superior performance and avoiding singularity conditions even in the presence of parameter 
uncertainty. This method seems to be very promising. Currently, we are investigating the 
benefits of using the virtual target vehicle principle to solve the combined problem of path 
following and obstacle avoidance for a unicycle type robot. 

In the study adopted, access to vehicle acceleration (and jerk) was done indirectly by 
resorting to the vehicle dynamics. The possible criticism that such a strategy may lead to 
poor performance or even instability (because of model parameter uncertainty) was partially 
addressed by incorporating an adaptive scheme. However, in the development that followed 
we tacitly assumed that external disturbances, measurement noise, and unmodeled dynamics 
were absent. Measuring the accelerations directly via a dedicated sensor suite and using that 
information in a newly designed control law has the potential to yield better performance and 
to simplify the complexity of the path following control scheme. However, this would certainly 
introduce a path for noise through the acceleration measurements. Clearly, this introduces a 
tradeoff in system design that must be explicitly studied. 

Finally, and in order to fully complete this study, the problem of path following in the 
presence of actuator saturation must also be addressed. 
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